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[57] ABSTRACT 

The invention is directed to a method of controlling accel- 
eration and deceleration time constants for a robot wherein 
the acceleration and deceleration time constants of a servo 
motor are each set at an optimum value based on the amount 
of movement, load, etc., thereby achieving a reduction in the 
operation time of the robot 

The control method controls the operation of the robot while 
setting the acceleration and deceleration time constants at 
optimum values for each block instruction, and comprises 
the following five stages: the first stage comprising deter- 
mining from the distance to the target position whether or 
not the speed will reach the taught speed (SI), setting the 
taught speed as velocity V if it is determined that the speed 
will reach the taught speed (S2), otherwise obtaining an 
ultimate velocity (S3) and setting the obtained ultimate 
velocity as velocity V (S4); the second stage comprising 
obtaining an output torque corresponding to the velocity V 
froma velocity-torque curve (S5); the third stage comprising 
ob tainin g an acceleration torque and a deceleration torque 
by subtracting a static load torque from the output torque 
(S6); the fourth stage comprising obtaining the magnitude of 
acceleration for acceleration and for deceleration (S7); and 
the fifth stage comprising obtaining an acceleration time 
constant and a deceleration time constant from the magni- 
tudes of acceleration and the velocity V (S8), and then 
determining the largest acceleration time constant and larg- 
est deceleration time constant in absolute value terms or 
determining the optimum acceleration time constant and 
deceleration time constant for each individual axis (S9). 

3 Claims, 4 Drawing Sheets 
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Fig. 1 
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Fig. 2 
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Fig. 5 
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METHOD OF CONTROLLING controlling acceleration and deceleration time constants for 

ACCELERATION/DECELERATION TIME a robot according to the present invention, which involves 

CONSTANTS FOR ROBOT determining servo motor acceleration and deceleration time 

" ^ constants at optimum values for each block instruction and 

This application is a continuation of application Ser. No. 5 thereby controlling the operation of the robot comprises the 
08/360,6*6 filed Jan. 3, 1995 now abandoned, which is a 37 1 following stages. 

of PCI7JP94/00794, filed May 17, 1994. First stage: Obtain ultimate velocity from the amount of 

movement by executing the block instruction (steps SI to 
TECHNICAL FIELD S4). 
The present invention relates to a method of controlling 10 Second stage: Obtain the output torque of the servo motor 
acceleration and deceleration time constants for a robot from the ultimate velocity (step S5). 
whereby the operation of the robot is controlled while Third stage: Obtain acceleration torque and deceleration 
setting the servo motor acceleration and deceleration time torque by subtracting static load torque from the output 
constants at optimum values for each block instruction in an J5 torque (step S6). 

NC program, and more particularly to a method of control- Fourth stage: Obtain the magnitude of acceleration for 
ling acceleration and deceleration time constants for a robot acceleration and for deceleration from the acceleration 
whereby the operation of the robot Is controlled while torque and deceleration torque and from the inertia! load on 
determining the optimum acceleration and deceleration time the servo motor at the current position and at the target 
constants for the each block instruction. ^ position (step S7). 

An NC program consists of a plurality of block Fifth stage: Determine the acceleration time constant and 
instructions, each of which performs one of operations such the deceleration time constant from the magnitude of accel- 
as linear interpolation, circular interpolation and the like. eration for the acceleration and for the deceleration, respec- 
tively (step S8, S9). 

BACKGROUND AFT 25 In the method of controlling acceleration and deceleration 

In the prior art acceleration and deceleration time con- time constants for a robot according to the present invention, 
stants for a robot are both set at the same value regardless of the ultimate velocity is obtained from the amount of move- 
the posture of the robot or the distance the robot must move. ment by the next block instruction to be executed. For 
Alternatively, optimum acceleration and deceleration time example, when the amount of movement is small, the 
constants are calculated from the posture at the current 30 moving speed is set at a small value, and if the amount of 
position and at the target position, and the larger of the two movement exceeds a predetermined value, the ultimate 
values is set as bom the acceleration and the deceleration velocity is equal to the taught velocity. From this ultimate 
time constant velocity and from the velocity-torque curve of the servo 

However, if these time constants are set with a ice way, motor, the output torque of the servo motor is obtained. This 
the time necessary to complete an NC program becomes 35 velocity-torque curve allows for viscous loss. By subtracting 
long. On the contrary, ifme time constants are set at a from the output torque the static load torque including the 
smaller value than required, the servo motor cannot be friction toque and the torque against gravity at current and 
suitably driven because of msuffident torque. This gives rise target positions, an acceleration torque ;for accelerating a 
to the problem that the NC program executing time cannot load and a deceleration torque for decelerating it are 
be shortened even if the servo motor is capable of providing 40 obtained Prom the acceleration torque ; and deceleration 
sufficient torque. In other words, this requires increasing the torque, the acceleration time constant and deceleration time 
servo motor size if the NC program executing time is to be constant are respectively oetermined, and the acceleration 
shortened, which leads to the problem of an increase in cost and the deceleration are : controUed mdependentiy of each 
Furthermore, for axes of the motions on which gravity 4J other. This achieves a reduction m the operation time of the 
acts, the effect of gravity may be different at the motion start ro 

position than at the motion end position. However, accord. An embodiment of the present invention will be described 
Lng to the prior art control method wherein the acceleration below with reference to the accompanymg drawings, 
time constant and the deceleration time constant are both set np^mnmnN OF the DRAWINGS 

at the same value, both of the accel-and-decel time constants ^ BRIEF DESCRIPTION OF THE DRAWING 
are set at the larger values, an extra operation time may be pjQ \ [ s & flowchart illustrating the basic processing 
required. sequence in a method of controlling acceleration and decel- 



DECLOSURE OF THE INVENTION 



eration time constants for a robot according to the present 
invention; 



In view of the above problems. It is an object of the 55 FIG. 2 is a diagram showing the relationship between the 

invention to provide a method of controlling the acceleration moving distance and moving speed of each axis of a robot; 

and the deceleration time constants for a robot whereby the piQ. 3 is a diagram showing the velocity-torque charac- 

operation time for a robot to complete a program is short- teristic of a servo motor, 
ened by setting the acceleration toe constant and decern- 

tion time constants of a servo motor, independently of each ^ , ^ , 

other, at optimum values according to the amount of FIG. 5 is a general block diagram of a robot control 

movement, load, etc, on the robot arm driven by the servo aprjaratus for carrying out the invention. 

motor - ^ ^ . BEST MODE FOR CARRYING OUT THE 

FIG. 1 is a flowchart illustrating the basic processing INVENTION 
sequence in a method of controlling acceleration and decel- 65 

eration time constants for a robot according to the present FIG. 2 is a diagram showing the relationship between me 

invention. To achieve the above object, the method of moving distance and moving speed of each axis of a robot 
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la the diagram, the abscissa represents the time, and the current position Pn as well as for the target position P(n+1). 

ordinate represents the speed. When the moving distance (or However, 60, LI, L2, and W are set separately because their 

the rotation angle) is sufficiently long, the graph passes values differ depending on the motion the robot is to 

through points o, a. b. and c as shown by line 2. That is, the perform. 

axis of the robot is accelerated to point a with time constant 5 FIG. 5 is a general block diagram of a robot control 

tO, moves constant at taught speed Vt, and decelerates until apparatus for carrying out the present invention. The robot 

it stops at point c. The area surrounded by lines joining control apparatus 30 includes a processor board 31 which 

points o, a, b, and c is the moving distance. As the moving contains a processor 31a, a ROM 31b, and a RAM 31c. The 

distance decreases, the constant speed period between a and processor 31a controls the overall operation of the robot 

b becomes shorter. When the distance between points a and 10 control apparatus 30 in accordance with the system program 

b is larger than zero, the motion from point o to point c is stored in the ROM 31b. The RAM 31c stores data, such as 

called a long motion. On the other hand, if the distance the above-stated LI, L2, and W, operation programs, etc. A 

between points a and b is zero or the constant speed period portion of the RAM 31c is organized as a nonvolatile 

does not exist the motion is called a short motion. At the memory. The data, operation programs, etc. are stored in the 

boundary between the long motion and short motion, the 15 nonvolatile memory area. The processor board 31 is coupled 

graph is the locus of points o, a, and d as shown by line 3. to a bus 39. 

When the moving distance further decreases, the acccl- A digital servo control circuit 32, which is coupled to the 

eration changes until it coincides with straight line od bus 39, drives servo motors 51, 52, 53, 54. 55. and 56 via a 

defined by the time constant tO and high-speed maximum servo amplifier 33 by instructions from the processor board 

velocity Vmax. and the result is line 4 passing through points 20 31. These servo motors are contained in the robot 1 and 

o. al. and c2. When the moving distance is further reduced, move the respective axes of the robot 1. A serial port 34, 

the result is line 5 passing through points o, a2. and c3. The which is coupled to the bus 39. is connected to a teaching 

maximum velocity attained at this time is Vu, which is called control panel 57 with built-in display, and also to other 

the ultimate velocity. RS232C equipment 58. The teaching control panel 57 with 

FIG. 3 is a diagram showing the velocity-torque charac- 25 built-in display is used to enter operation programs, etc. 

teristic of a servo motor. In the diagram, the abscissa The serial port 34 may also be connected to a CRT 36a. 

represents the velocity (V) and the ordinate the torque (T). An operation panel 36b is connected to a digital VO 35. 

That is. when a particular velocity (V) is determined, the Signals are output to external devices via the digital I/O 35 

maximum torque Tmax corresponding to that velocity is OT analog I/O 37. A large-capacity memory stores operation 

also determined. These relationships are stored in a robot programs, etc. 

control apparatus as data for each of the servo motors jjj the above description, the servo control circuit is 

contained in the robot described as a digital servo control circuit, but instead, an 

FIG. 4 is a schematic diagram of the robot When the analog servo control circuit may be used* 

mounting angle of the robot is denoted as 80, the axis angles 35 Referring back to FIG. 1. a detailed description will be 

of first to sixth axes as 61, 82 66, respectively, the load gj VCQ below. FIG. 1 is a flowchart illustrating the basic 

weight as W, and the offset amounts from the center of the processing sequence in the method of controlling accelera- 

fifth axis to the load gravity center O as LI and L2, men the (ion and deceleration time constants for a robot according to 

static load torques and moments of inertia about the re spec- ^ present invention. In the figure, the number suffixed to S 

tive axes are expressed by the following equations. The ^ designates the step number. 

static load torque includes the friction torque and the torque ^ S1) . ftom ^ distance to the target position, a decision 

against gravity. is as to whether or not the speed will reach taught 

Denoting the moments of inertia about the first to sixth speed vt If it is decided mat the speed will reach Vt, the 

axes as II, 12 16, and likewise, the static load torques process proceeds to S2; otherwise, the process proceeds to 

as Twl, TW2 , Tw6. these values can be obtained from 45 53. 

the following equations. ^j): The taught speed Vt is chosen as velocity V. 

(S3): Ultimate velocity Vu is obtained from the following 



U = F1(92,93,64,95,96,L1,L2,W) equation, using distance X to the target position. 
12 = 1^63,64,65, 96, LI, L2, W) 

D = P3(94, 95, 66, LI, L2, W) » Vfc=V(X VtaaxrtO) 

SlSuLiw^ (S4):The ultimate velocity Vu is chosen as velocity 

16 = f$Li, ix W) (S5): The maximum torque Tmax corresponding to the 

Twl « 01(90, 91, 92, 93, 94, 95, 96, Li, L2, W) velocity V is obtained from the velocity-torque curve shown 

Tw2=O2(90,91,92,e3,94,95,96,Ll,L2, W) in FIG 3 

£4 : 9!; H %: * £ H: u\ S $ 55 ^ acceleration torque Ta is obtained by subtract- 
Tw5 =* G5(90, 91, 62, 63, 94, 95, 96, Li, L2, w) ing the static load torque Tw from the m ax imum torque 
Tw6 = G6(90, 91, 62, 63, 94, 95, 96, Li, L2, W) Tmax. From the static torque at the current position, Two, 
~ and that at the target position, Tw(n+1), acceleration torque 

These functions Fl to F6 and Gl to G6 can be calculated „ ^'^1°° ^ Ta(ftfl) "° ***** f ° r 

from the construction and the current posture of the robot respective posiuons. 
Therefore, when the robot Is in a particular posture, the 

moments of inertia II to 16 and the static load torques Twl TEj=7W-7Wn 
to Tw6 can be Obtained by calculation within the robot 

control apparatus. 65 



When reproducing a program, the moments of inertia and (S7): From the acceleration torque Tan and deceleration 
the static load torques are calculated successively for the torque Ta(n+1), and from the moment of inertia at the 
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20 



25 



current position. In, and that at the target position, I(n+1), 
the magnitudes of acceleration, an and a(n+l), are obtained 
for the respective positions. 

(SS): From the magnitudes of acceleration, an and a(n+l), 
and the velocity v, acceleration time constant ia and decel- 
eration time constant xf} are respectively calculated using the 
following equations. 

xo«(ii+tyV 15 

Here, the acceleration and deceleration time constants can 
be adjusted by multiplying by a fine adjust constant A at each 
taught point in other words, each predetermined point in the 
program. 

Steps SI to SS are repeated for each axis. 

(S9): The largest acceleration time constant vx and largest 
deceleration time constant xp in absolute value terms are 
determined for each axis. Alternatively, of the acceleration 
time constants ta and deceleration time constants ?0 for the 
six axes, the largest ones in absolute value terms are 
determined as the acceleration time constant and decelera- 
tion time constant for each of the axes. Thus, by setting the 
acceleration time constant and deceleration time constant 
respectivdy at the sarne values for all axes, that is, by setting ^ 
all the axes with the same acceleration, the aid of the robot 
arm is prevented from deviating from the taught path. In 
cases where the intermediate path is not a concern, the 
acceleration time constant and deceleration time constant 
need not be set respectively at the same values for all axes. 
In such cases, by setting the acceleration and deceleration 
time constants at optimum values for each individual axis, 
the operation cycle time can be further shortened. 

The above description has been given by taking a six-axis 
articulated robot configuration as an example, but far robots 
of other configurations also, the acceleration time constant 
and deceleration time constant can be set at optimum values 
in the same manner as described above, to shorten the 
operation time of the robot 

As described, in the method of controlling acceleration 
and deceleration time constants for a robot according to the 
invention, the acceleration time constant and deceleration 
time constant are determined for each individual axis from 
the ultimate velocity, moment of inertia, static load, etc. 
Accordingly, the acceleration time constant and deceleration 
time constant can be set at optimum values, which contribute 
to shortening the operation time of the robot 
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40 



45 
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We claim: 

1. A method of controlling acceleration and deceleration 
time constants for a robot wherein operation of the robot is 
controlled while setting the acceleration and deceleration 
time constants of a servo motor at optimum values for each 
of a block of instructions, comprising the steps of: 

determining a maximum velocity from an amount of 
movement as a result of execution of each of a block of 
instructions; 

determining an output torque of a servo motor based in 
part on said maximum velocity in said each block of 
instructions and a maximum torque corresponding to 
said maximum velocity; 

determining an acceleration torque and a deceleration 
torque by subtracting a static load torque from said 
output torque; 

determining a magnitude of acceleration far acceleration 
and a magnitude of deceleration for deceleration from 
said acceleration torque and said deceleration torque 
respectively, and from load inertia at the current posi- 
tion and at the target position of said servo motor, 

determining an acceleration time constant and a decelera- 
tion time constant from said magnitude of acceleration 
for acceleration and said magnitude of deceleration for 
deceleration; and 

controlling acceleration and deceleration of a robot based 
upon said acceleration time constant and said decelera- 
tion time constant respectively. 

2. A method of controlling acceleration and deceleration 
time constants for a robot according to claim 1, said method 
further comprising controlling a plurality of servo motors, 
wherein 

of the acceleration time constants of said plurality of 

servo motors, a largest acceleration time constant in 

absolute value terms is selected, 
of the deceleration time constants of servo motors, a 

largest deceleration time constant in absolute value 

terms is selected, 
and all of said plurality of servo motors are controlled 

using said selected acceleration time constant and said 

selected deceleration time constant 

3. A method of controlling acceleration and deceleration 
time constants for a robot according to claim 1, said method 
further comprising controlling a plurality of servo motors, 
wherein 

said plurality of servo motors are controlled by determin- 
ing said acceleration time constant and said decelera- 
tion time constant for each individual servo motor. 
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